// deze code is voor het generene van een toon van 1000Hz
import stamp.core.*;

public class PwmTest {

static PWM servoffssaaaLinks = new PWM(CPU.pin12,173,2304);
static PWM servoRechts = new PWM(CPU.pin13,173,2304);

    public static void main() {
        while(true){
        moveBot();
        } // end while
    } // end main


    public static void moveBot()
    {
    switch( Terminal.getChar() ) {
    case 'w':
     servoLinks.update(220,2304);
     servoRechts.update(130,2304);
     break;

    case 'f':
     servoLinks.update(173,2304);
     servoRechts.update(173,2304);
     break;

     case 's':
     servoLinks.update(130,2304);
     servoRechts.update(220,2304);
     break;

     case 'a':
     servoLinks.update(173,2304);
     servoRechts.update(0,2304);
     break;

     case 'd':
     servoLinks.update(220,2304);
     servoRechts.update(173,2304);
     break;

    }
    }
}